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Abstract 

The Robotics Research Model K-1207 manipulator is a redundant 7R serial link arm with offsets at 
all joints. To uniquely determine joint angles for a given end-effector configuration, the redundancy is 
parameterized by a scalar variable which corresponds to the angle between the manipulator elbow plane 
and the vertical plane. The forward kinematic mappings from joint-space to end-effector configuration 
and elbow angle, and the augmented Jacobian matrix which gives end-effector and elbow angle rates 
as a function of joint rates, are also derived. 


1. Introduction 

The Robotics Research Model K-1207 arm is a seven degree-of-freedom serial link manipulator 
which offers one extra degree of joint-space redundancy over that needed for the fundamental task of 
end-effector placement and orientation. In this paper, a reasonable task-space parameterization, 
is first given of the redundancy, and the forward kinematic mappings from joint space to end-effector 
configuration and if, are then derived. We also give the augmented Jacobian, J A , which gives end- 
effector rates and ^ as a function of joint rates. A longer and more complete version of this paper is 
available which contains proofs, as well as an analysis of the kinematic and algorithmic singularities 
of the augmented Jacobian. 

2. Forward Kinematics 

2.1. Mapping from Joint-Space to End— Effector Configuration 

The Robotics Research Model K-1207 arm is essentially a 7R spherical-revolute-spherical ma- 
nipulator, but with additional nonzero offsets (denoted by the link lengths a,, i = 1, - • • ,6) at each of 
the joints, as shown in Figures 1-3. Denavit-Hartenberg (D-H) link frame assignments are given in 
accordance with the convention described in [1]. This assignment results in the following general form 
of the interlink homogeneous transformation matrix: 
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where 6 t denotes the i th joint angle. The D-H parameters for the K-1207 arm are given in Table 
1. The link frame assignments for the K-1207 are given in Figure 2, where the arm ls^shown in its 
zero configuration. The link i coordinate frame is denoted by T, with coordinate axes z t ) and 

origin O,. The associated interlink transformation matrices, i = 1, • - * 7, are easily found from 

the above expression evaluated for the D-1I parameter values listed in Table 1. If the link length 
parameters a { , i = 1, - - > ,6 are set to zero, the 7R anthropomorphic arm described in [2] is retrieved 
and we call this arm the “zero-offset” arm. 
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The forward kinematic function, °T 7 , which gives the position and orientation of the end-effector 
as a function of joint angles 0 = , - - • ,0 7 ) T , is °T 7 = »T X -~*T 7 . If these multiplications are 

performed to obtain a symbolic form for °7 V , the resulting expression will be complex due to the 
multitude of nonzero link offsets and the fact that no two consecutive joint axes are parallel. Rather 
than construct and implement the symbolic expression, it is more efficient to compute the forward 
kinematic function ®T 7 via a link— by— link iteration of the form 

°T, = °T t _ 1 • { - l Ti , t=l,. ..,7 (1) 

thus exploiting special structural properties of the homogeneous transformation matrices during each 
link update. Furthermore, it is useful to explicitly have the interlink homogeneous transformations, 

Ii, since important quantities such as the vectors w , e, and p defined later — can then be 
computed. In fact, such quantities are often a direct result of the intermediate steps of the iteration 

2.2. Mapping from Joint-Space to Elbow Angle 

When the arm is in a kinematically nonsingular configuration, there will generally exist one excess 
joint degree-of— freedom for the task of end effector control since there are seven joint angles available 
to orient and position the end-effector — a task which requires only six degrees of freedom. As a 
result, for a fixed end-effector configuration there is generally a one-dimensional subset of joint space 
(a “self-motion manifold”) which maps to this configuration. Actually, there are finitely many, up to 
16 in the most general case, such manifolds or “poses” [3, 4], The extra degree of freedom represented 
by a self-motion manifold can be used to attain some additional task requirement, provided that this 
task can be performed independently of end-effector placement [5, 6]. Furthermore, the imposition 
of an auxiliary task constraint can provide sufficient additional information to uniquely determine 
the joint angles (modulo the remaining finitely many-to-one mapping property represented by the 
pose [3, 4]). This scalar additional task variable is denoted by ip and is assumed to be a meaningful 
parameterization of the self-motion manifolds which map to a given end-effector configuration. We say 
that the “basic” task of end-effector placement has been augmented by the additional task represented 
by ip. In essence, the concept of the forward kinematic map is generalized to be the (finitely many- 
to-one) mapping from 0 £ R 7 to (°T 7 ,ip). 

Although ip can be any additional scalar parameter which is independent of end— effector configu- 
ration, we define and use the “elbow angle” to resolve the manipulator redundancy. Refer to Figures 
3 and 4 where S = 0\, E = O4, and W = 0 7 denote the origins of link frames 1, 4, and 7 respectively. 
ip is defined by the angle from the vertical plane containing the shoulder-wrist line (line 5W) to 
the shoulder— elbow— w'rist plane (plane SEW) in the right-hand sense about the vector w = W — S. 
Assuming that the elbow angle ip is a meaningful parameterization of manipulator redundancy, a self- 
motion is described by a rotation of the plane SEW about the line SW . Note that the elbow angle ip 
is undefined when the wrist point W is anywhere on a line above the shoulder point S — even though 
this is generally not a singular configuration — since in this case the vertical plane is not uniquely 
defined, ip is also undefined when e and w are collinear since then the plane SEW is not uniquely 
defined. In the latter case, the arm is either nearly fully outstretched, or folded, and is therefore near 
or at an “elbow singular” configuration [3, 7]. 

To derive the forward kinematic function which gives ip as a function of joint angles, again consider 
Figure 4. Let w = W - S , e = E - S, and let V denote the unit vector in the vertical direction of 
the base frame. Let the projection of e onto w be given by d = ui(w T e), w = wj\\w\\. The minimum 
distance from the line SW to the point E is along the vector p = e - d = (I - ww T )e. The vertical 
plane is the plane which contains both w and^the vertical unit vector V. The unit vector in the vertical 
plane which is orthogonal to w is given by l = l/\\t\\, with f=(tcxV)xw. We also define the unit 
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vector p = p/||p||. Note that e, w, w, d , p, p, /, and t can be computed during the forward kinematics 
iteration (1) (see the discussion following equation (6) below). 

The vector l, or equivalently £, is treated as a free vector which can slide along the line SW. In 
particular, £ is moved along the line SW until its base is in contact with the base of vector p at the 
point d (see Figure 4), so that xp is the angle from l to p. This construction results in 

c* = ( T p, s^w = £xp, = w T (£x p) (2) 


where c ^ = cos?/’ and s ^ = suv'ip. This gives 


tan xf) = 
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( 3 ) 


The result (3) can be simplified somewhat^ Defining g = w X w, we have £ = gxw, and we note that 
(T g _ _ q This means that £ and V are coplanar, both lying in the vertical plane. Since, in 

general, the vertical plane is spanned by V and w, we have 

£ = aV + /3w, a=l/{£ r V), 0 = -aw T V (4) 


Substituting this result into (2) gives 


CJ, ~ aV T p, St = aw T (V X p) 


which can be used with (3) to obtain 


tan ij) — 


w T (V X p) 

V T p 


w T (V x p) 

V T p 


( 5 ) 


Equation (5) immediately gives 
elbow angle ip: 


the forward kinematic function which maps 
ip = atan2(ui T (F X p),V T p) 


the joint angles 6 to the 


( 6 ) 


Note that (6) is undefined when both arguments are simultaneously zero. This occurs when the arm 
is in a configuration for which e and w are collinear, or for which the wrist point W is directly above 
the shoulder point 5 on the line through V. These indeterminacies are discussed above, and are due 
to the inability to uniquely define the elbow plane SEW or the reference vertical plane, respectively. 

The augmented forward kinematics mapping 9 — *■ ( 0 7V,VO ' s gi ven by (1) and (6). The quantities 
w and p = e — d — {I - ww T )e are first computed during the iteration (1), after which ip is computed 

by (6). Note that, with 
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quantities which are directly computed during the iteration (1), the representations of e and w in the 
base (link 0) frame Eo are precisely °e = 0 P 4 and °w = °Pj. Also note that V is a constant vector 
which is usually expressed in a frame which gives it a particularly simple form such as (0,0,1) or 
( 1 , 0 , 0 ) T . 
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3. Differential Kinematics 


3.1. Manipulator End-Effector Jacobian, J e€ 

To present actual values for the end— effector Jacobian, </ ee , it is first necessary to choose a 
velocity reference point,” as well as a frame in which to represent the vectorial quantities which 
define the columns of the Jacobian. In this section, to simplify notation, we will suppress the trailing 
superscript and write the end— effector Jacobian simply as J — J ee . When a velocity reference point 
a, and a representation frame, T r , have been chosen (as discussed immediately below), we write 

r t _ r jee n 

J a • 

Let u? a and v a be the angular and linear velocities of a coordinate frame, T a , located at a point a 
and fixed with respect to the manipulator end-effector. The point a is known as a “velocity reference 
point” of the end-effector. The Jacobian, J a (0) £ R 6x7 , relates joint rates to the frame T a rate of 
change via the linear relationship (u>a>v£) T = J a (9)9 and is given by [8] 


Ja 


V X Pa, 1 


z 7 

z 7 X P a j 


) 


(7) 


In (7), denotes the unit vector corresponding to the z-axis of link frame i (i.e. of T x ) while 
P a ,i = P a ,o, = a - Oi is the vector from the origin, O t , of link frame i to the point a. Note that 

Pi,i = o. 

Let T b denote an alternative frame fixed with respect to the end-effector and located at the 
velocity reference point b. The relationship between joint rates and the rate of change of J- b is given 
by (Wj, ,v b ) = J b 0. Let T r and 7 s be frames which are not necessarily fixed with respect to the 
end-effector. The representations of u a and v a in frame T r are denoted by r u a and r v a . Similarly, 
s u; b and s v b are the representations of u b and v b in T s . Note that we have defined a and b to be 
end-effector reference points, i.e. to be fixed with respect to the end-effector, while we have placed 
no constraints on r and s. 

The Jacobian, r J a , giving the rate of change of T a represented in T r , is related to s J b , the 
Jacobian giving the rate of change of frame T b represented in frame T„ by [1, 9] 



where, for a 3-vector x, x denotes the 3 X 3 skew symmetric matrix defined by xy = x X y for every 
y G R 3 and P a<b = a — b. When r = b, we write b P a = b P atb . r R a 6 R 3x3 is a rotation matrix, 
represented in frame P r , which gives the orientation of frame T, with respect to frame T r . Common 
choices of r J a are given by 7 J ? , and °J 7 . It is straightforward to show from (8) that 


det r J a {0) T J a (0f = det s J b (0) r J b (0) T (9) 

for every a, b, r, and s. Since an m X n matrix M, m < n, is full rank if and only if det MM r / 0, 
eq. (9) shows that the singularity of a manipulator Jacobian is independent of the choice of velocity 
reference point and representation frame, and is a function purely of the manipulator configuration 
variables 6. 


An important aspect of the decomposition (8) is that s and b can often be chosen to make the 
Jacobian matrix have a particularly simple structure for the purposes of singularity analysis, efficient 
evaluation, and efficient inversion. For example, in [10] an algorithm for the efficient computation of 
°J 0 is given. Note that J 0 does not give the velocity of the base frame, JF 0 , as a function of joint 
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rates — indeed, in most cases the base is assumed fixed and the base frame origin, O 0 , cannot be a 
velocity reference point for the moving end-effector. Instead, J 0 is viewed as giving the velocity of a 
reference frame fixed with respect to the end-effector and instantaneously coincident with the base 
frame origin, Oq- The computation of 
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where k Pij = ° k P,j and P %J = P 0 „o, = Oj - 0„ naturally fits in with the forward kinematics 
iteration (1), since from 

o 

°P t = °P t , 0 , we can obtain °P 0 ,. = -°Pi and 0 z< X °P 0<i where = °P,e 3 , e 3 = (0,0, l) r . Having 
°J 0 , °Jt can then be found from (see (8)) 



°Jt = 



( 11 ) 


The symbolic forms of 0 J 0 and 0 J 7 can be found from this procedure, but these expressions are complex 
and provide little insight. 

In [9], the results in [10] are extended to show that taking s - 0{ and b = Oj for an appropriate 
choice of link frames i and j can result in an expression ' Jj = °'Jo, which is not only efficient to 
compute, but which simplifies singularity analysis and (for nonredundant manipulators) inversion. In 
particular, to gain insight into the singularity structure of the K-1207 end-effector Jacobian (and to 
obtain alternative ways of constructing °Jo anc l °>^ 7 ) we w iU let b — 3 (i.e., let the velocity leference 
point be the origin of link frame 3) and s = 3 (let the reference frame be link frame 3) in (9) to 
arrive at an expression for 3 J 3 . J 3 should be interpreted as giving the velocity of a fictitious tool 
frame which is instantaneously coincident with link frame 3. 3 J 3 is found from eq. (7) by taking 
p ai = p 3 t = Pq 3 = 0 3 — Oi and representing z,- and P 3 ,j in link frame 3 to obtain 3 zf and 
3 j.’ x 3 P 3 i, 3 P 3 ,• = '° 3 ' Po 3 ,o, ■ The symbolic expression for 3 J 3 found in this manner is given by 
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Having 3 J 3 , 0 Jo is found from (see eq. (8)) 



( 13 ) 
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with °/'3 = °/ > 3 ) o given by 
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The relative simplicity of (12) not only enables one to efficiently compute °J 7 via eqs. (11)-(15), 
but also allows one to gain insight into conditions leading to Jacobian singularity. In the special case 
of the zero-offset arm discussed in [2], corresponding to a, = • • • = a 6 = 0, (12) simplifies to 


CM 

I 

S 3 

0 

0 

S4 

-C4S5 

C 4 C 3 Se + S 4 Ce \ 

S2S 3 

c 3 

0 

1 

0 

C 5 

S 

c 2 

0 

1 

0 

c 4 

S 4 S 5 

C 4 C 6 - S 4 C 5 S 6 

d 3 S 2 S 3 

d 3 C 3 

0 

0 

0 

-d 5 C 4 C 5 

—d 3 C 4 S5Se 

d 3 S 2 C 3 

-d 3 S 3 

0 

0 

0 

—d 3 S 5 

d 3 C 3 Se 

0 

0 

0 

0 

0 

d$S 4 C 5 

d 5 S 4 S 5 S 6 J 


3.2. Elbow Angle Jacobian, ,7^, and the Augmented Jacobian, J A 

Let the relationship between the rate of change of a scalar additional task variable, ip, and the 
joint rates be given by ip — ,/ 6 . The “augmented” Jacobian is given by 


J A = 



where J is the end effector Jacobian discussed in Section 3.1. For the task of positioning and 
orienting the end-effector augmented by an additional task represented by ip, the augmented Jacobian 
relates joint rates to the simultaneous rates of change of the end— effector and ip. Given the end— effector 
Jacobian, J ee , the augmented Jacobian J A is obtained once J * has been determined for a given task 
variable ip. In this section, is constructed for the case where ip describes the angle between the 
vertical plane and the elbow plane SEW as defined in Section 2. 

Before proceeding, it is necessary to define the Jacobians E and W which relate joint rates to 
e and w respectively via e = E 6 and w = W0, where e and w are defined in Section 2.2. e is the 
linear velocity of the manipulator elbow point E = O4, and w is the linear velocity of the wrist point 
YV = Oj. We have 


E = (2! X P 4il , Z 2 XP 4 , 2 , 23 X P.,,3, 0, •••, 0) (17) 

W = (2 1 xP 7 ,i, •••, ? 6 xP 7 , 6 , 0) (18) 

where P t j — Oj — Oi. Note that eqs. (17) and (18) are given in coordinate— free form and that to 
provide values for E, or W, a choice of reference frame for representing Sj and P,j must be made. 

Also note that (compare eqs. (7) and (18)) </ 7 e = ^ ^ ^ , so that any procedure for producing a value 

for J 7 = Jj e (such as the one discussed following eq. (10)) automatically results in a value for W. 
Furthermore, just as one can construct °W from knowledge of i ~ 1 T i , i = 1, • • • , 7 (say in the manner 
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discussed after eq. (10)), one can readily compute values for E given the interlink homogeneous 

transformations 

Recall the definitions of l,i,V, V, P, *>, and e g iven »“ Section 22 f f S ° T^JiThomoeenetlis 
Section 2.2, that these quantities can all be computed from knowledge of the interlink homogeneous 

transformations t ~ 1 T{. 

Lemma 3.1: The relationship between 9 and t/>, where is the elbow angle as defined in Section 2.2, 
is given by 
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Since the elbow angle V> is given by the angle from t to p, it is natural that V> should depend only 
on 1 and p as in eq. (19a). Equation (19a) says that only the components of t and p which result in 
an instantaneous motion of i and p directly towards or away from each other can produce a change . 
the elbow angle, V>. Based on our earlier discussions, it should be obvious that J can be constru 
from knowledge of the interlink homogenous transformations ' T,. Also note that J is indepen cn 

of the reference frame chosen to represent the quantities in the right hand side oi eq. (2U). 

4. Conclusions 

In this paper the forward kinematic functions which give end-effector configuration and elbow 
angle as a function of joint angles for the Robotics Research Model K-1207 manipulator have been 
derived. Also given is the augmented Jacobian which relates joint rates to end-effector and elbow 
angle rates. Omitted derivations can be found in a longer and more complete version of this paper 
available from the authors. The fuller version of this paper also contains a detailed singularity analysis 

of the augmented Jacobian. 
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Tool Plate Roll 


FIGURE 1: Robotics Research Model K-1207 Arm 
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1 


«i-i aj_i 


dj 0i 


10 ° 0 0 01 

2 -90° ai 0 0 2 

3 +90° a2 d 3 03 

4 -90° a 3 0 0 4 

5 +90° a 4 d 5 05 

6 -90° a 5 0 0 6 

7 +90° a 6 0 07 


ai = +4.850 in = +12.319 cm 
a 2 = -4.250 in = -10.795 cm 
a 3 = -3.125 in = - 7.938 cm 

a 4 = +3.125 in = + 7.938 cm 

a 5 = -1.937 in = - 4.920 cm 

a 6 = +1.937 in = + 4.920 cm 

d 3 = d 5 = 21.5 in = 54.61 cm 


TABLE 1: Denavit-Hartenberg Parameters of the K-1207 Arm 



FIGURE 2: Robotics Research Model K-1207 Link Frame Assignment 
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